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ABSTRACT 

Analytical  expressions  are  developed  which  relate  the  translational 
and  angular  accelerations,  velocities,  and  displacements  oC  t body  with 
the  outputs  of  six  correctly  placed  Internal  motion-sensing  transducers. 
These  expressions  are  In  a form  that  is  easily  converted  Into  computer 
programs  for  analysis  of  data  taken  by  mot  Ion -sens  I ng  transducers  in 
any  sort  of  free  vehicle.  Thus  they  are  appropriate  for  use  in 
experimental  studies  In  which  the  motion  of  tc.pedoes,  missiles,  etc. 

Is  to  be  measured. 

ADMINISTRATIVE  INFORMATION 

This  work  was  funded  bv  the  Navol  Air  Systems  Command,  PMA  258,  under 
AIRTASK  A510-51 09/01 0-C/2W1 3X1 -000 , Work  Unit  1-1556-033. 

INTRODUCTION 

Over  the  past  several  years,  the  David  W.  Taylor  Naval  Ship  Research 
and  Development  Center  (DTNSRDC)  has  been  requested  to  perform  model 
launching  studies  on  a variety  of  torpedoes  and  missiles.  Performance  of 
these  experiments  has  required  the  development  of  techniques  for  measuring 
the  motion  of  rigid  bodies  in  up  to  six  degrees  of  freedom.  Two  main 
approaches  to  this  problem  have  been  tried. 

One  approach  Is  to  make  the  measurements  photographically.  Films 
taken  by  a stereoscopic  pair  of  synchronized,  high-speed  motion  picture 
cameras  may,  in  principle,  be  analyzed  photogramme tr leal ly  to  yield  a 
complete  time  history  of  the  motion  of  a body.  This  technique  has  the 
advantage  of  requiring  no  attachments  of  any  kind  to  the  body  itself. 

The  main  disadvantage  of  this  technique  is  that  the  analysis  Involved  is 
quite  laborious  and  time  consuming.  Also,  experience  has  shown  that 
extreme  care  must  be  used  In  setting  up  and  calibrating  the  required  systems. 
Photographic  measurement  techniques  have  been  used  at  DTNSRDC  with  some 
success  and  are  still  being  developed. 

The  alternative  to  photographic  measurement  Is  to  equip  the  body 
with  internal  motion-sensing  transducers.  This  technique  Is  viable  if 
the  model  is  large  enough  to  contain  the  transducers  and  if  the  physical 
situation  allows  the  use  of  a trailing  unbilical  cable  for  telemetering 
the  transducer  signals.  This  report  is  concerned  with  this  second 
technique . 


Complete  determination  of  the  motion  of  the  body,  i.e.,  all  six 
components  of  motion,  requires  at  least  six  transducers.  The  most 
common  type  of  motion-sensing  transducer  is  the  accelerometer. 

Physical  size  limitations  and  other  considerations,  however,  often 
preclude  the  use  of  accelerometers  for  the  measurement  of  all 
components  of  motion.  Other  types  of  motion  sensors  include  angular 
rate  gyros  and  angular  accelerometers.  However,  the  use  of  gyros  or 
other  moving  mass  devices  is  often  undesirable  in  model  testing 
because  a moving  mass  may  significantly  alter  the  desired  mass 
distribution  or  impart  undesired  stability  to  the  model.  A new 
type  of  electrofluidic  angular  rate  transducer  has  recently  become 
available  commercially.'  Since  this  device  does  not  utilize  a moving 
mass,  It  does  not  exhibit  the  undesirable  characteristics  (for  this  type 
of  work)  of  rate  gyros.  These  devices,  as  well  as  accelerometers,  are 
available  in  sizes  small  enough  to  be  practical  for  use  in  models. 

Several  combinations  of  accelerometers  and  angular  rate  sensors 
can  be  used  to  determine  the  motion  of  a body.  The  particular  combination 
chosen  would  depend  on  the  availability  of  the  various  types  of  transducers. 
The  useful  combinations  are  (1)  three  accelerometers  and  three  angular  rate 
sensors  and  (2)  five  accelerometers  and  one  angular  rate  sensor. 

Data  analysis  procedures  are  needed  for  converting  the  outputs  of 
motion-sensing  transducers  Into  quantities  which  describe  the  motion  of 
a boHv  in  a reasonable  and  straightforward  way.  Thus,  the  equations  of 
motion  must  be  put  Into  a form  which  makes  obvious  the  dependence  of  those 
parameters  normally  used  to  describe  motion  on  those  quantities  which  are 
measurable  with  transducers.  Furthermore,  the  types  of  mathematical 
relationships  developed  for  this  purpose  should  be  easily  converted  Into 
software  for  use  on  high-speed  digital  computers.  Since  no  readily 
available  references  were  found  containing  relationships  of  this  type, 
this  report  develops  the  equations  of  motion  from  this  point  of  view  and 
presents  analytical  relationships  appropriate  for  reduction  of  data 
acquired  by  two  useful  transducer  nations. 

'Humphrey,  Inc.,  "A  Solid  State  Angular  Hate  Sensor,"  Brochure  BR006*»-272 
(undated) . 
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GENERAL  EQUATIONS  OF  MOTION 

Although  the  equations  of  motion  for  a rigid  body  are  well  known,  it 
Is  useful  to  derive  them  from  basic  principles  In  order  to  gain  physical 
and  mathematical  Insight  Into  the  problem.  While  going  through  the 
derivation,  It  Is  Important  to  keep  In  mind  that  the  purpose  Is  to 
develop  equations  for  converting  measurable  quantities  Into  useful 
Information.  Thus,  we  should  be  on  tha  lookout  for  directly  measurable 
quantities  in  the  equations. 

The  problem  Involves  two  coordinate  systems.  One  system,  with  axes 

A A ^ 

Xq,  yQ,  and  zQ  and  unit  vectors  1,  J,  and  k,  respectively,  is  fixed  in 
space.  The  second  coordinate  system,  which  shall  be  called  prime  ('), 
is  moving  with  respect  to  the  fixed  system.  The  prime  coordinate  system 
has  axes  x,  y,  and  z with  unit  vectors  e^,  ey,  and  ez,  respectively.  Time 
derivatives  taken  in  the  prime  coordinate  system  will  be  denoted  by 
d'/dt.  Derivatives  taken  in  the  fixed  system  will  be  denoted  in  the  usual 
way. 

In  the  fixed  coordinate  system,  let  m be  the  position  vector  of  the 
origin  O'  of  the  moving  coordinate  system.  See  Figure  I.  The  translational 
velocity  of  O'  Is  given  by 

- u » uex  + vey  ♦ wez  [ 1 ] 

The  translational  acceleration  of  O'  Is  given  by 

,2+  ♦ 

- A-  aO+aii+aS  [2] 

dt2  x x y y z z 

The  rotational  motion  of  the  prime  system  can  be  described  by  the 
angular  velocity  vector  Z where 

3 «■  pex  ♦ qey  > rS,  [3] 
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'B^xB’  yB’  ZB^ 


Moving  (')  System 


Fixed  System 


Figure  1 - Relation  between  Fixed  and  Moving  Coordinate  Systems 


Consider  a point  B with  coordinates  Xg,  yg,  z&  in  the  prime 
coordinate  system.  Its  position  vector  in  the  prime  system  is 


b'  • V,  * Vy  * V. 

The  position  vector  of  B in  the  fixed  system  is  b.  It  is  easily 
seen  in  Figure  1 that 


+ ♦ 

b • b1  + m. 


and,  therefore,  that 


i ?•*  2* 

UL 

2 2 *w  * 2 2 
dt  dt  dt  dt 


If  the  first  term  of  (5)  is  examined  more  closely,  it  is  seen  that 


d2?'  d ,d*b' 

v - -rr1  (— rr~  ♦ w x b ] 


V ^ 

i . j 
• * * 


t$**<  *”g  ;»?  - * *~w  «■»»•■»  ■ *.--.  - mm  W'Wwyltwft’yiw  ^tv>jVM<«».J»wy-i*«^  »w-gw*«»y  " 


2-»  2 ■♦  -# 

d b'  d 1 b 1 , -*  ,-♦  +,  s „-*  d'b' 

— s—  ■ 1 1 , + u x (b>  x b 1 ) + 2w  v — — 

dt2  dtZ  dt 


dtu 

dt 


x b 1 


Substituting  [6]  into  [5]  yields 


[6] 


2~+  2~*.  ~* 
d b d'  b -*  ,-*  ^t,  x ,4  d'b1 

— 7 ° s—  + wx  U x b ) +2ujx  '•■-•- 

dt2  dt2  dt 


. . . 2~* 
d'j  :♦  A d m 

*-xb 


[7] 


Equation  [7]  is  the  vector  equation  of  motion  for  a point  on  a rigid 

-h  —►  -4  . 

body  and  is  often  called  the  Coriolis  theorem.  The  term  u»  x (w  x b'} 
Is  the  "centripetal  acceleration",  and  the  term  2u  x d'b'/dt  is  the 
"Coriolis  acceleration." 

If  the  point  B Is  assumed  fixed  with  respect  to  the  prime 
coordinate  system,  then 

d'V  . 


and 


dt 


v*  d'b' 

2“  x _ - 0 


Therefore,  Equation  [7]  reduces  to 


d2b 

dt2 


/ *•  j.  dtu  | 

u x (ui  x b'j  ♦ *jr  * b * 
dt 


d2£ 

dt2 


(8] 


If  the  first  term  of  [8]  is  evaluated  in  terms  of  Its  components, 


then 


f 

m. 


W x (u  x iT* ) « (yB (pq)  “ xft(q2  + r2)  + 2n(pr))  ev 


'8' 


B 


♦ t2B (qr)  - yQ ( r*  ♦ p ) + x0 (pq)  1 3, 

♦ lx0(pr)  - 2g  (p2  ♦ q2)  ♦ y0(qr)]  c 


19) 


1.1 
"■  a \. 


To  evaluate  the  second  term  of  (8],  note  that 
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V/g  .7i."^V va  ,'!V'r>^K.".  \ * *S*-W' I'M? C 


dw 

dt 


* * . * a , * A 

p e + q e + r e 

r x ^ y z 


Then  In  terms  of  components 


duj 

dt 


X b‘  = (qzB  - ryB)  ex  + (rxR  - pzR)  ey  + (pyn  - qxn)  e 


6 K B °y  'HyB  MV  z 


Substituting  [3]  and  [10]  into  [8]  yields 


d2b 


dt 


2 3 [yB (pq  - r)  + z (pr  + q)  - x (q  + r )]  e 


+ lzR(qr  ’ p)  + (pq  + r)  - y (r~  + p2)  ] e 


+ [x0 (pr  - q)  + Yglqr  + p)  - 2g (p2  + q2)]  e 

+ djr 
dt2 

If  Equation  [2]  is  substituted  into  [11],  then 


d **  b < , 

" tax  + VPq  ' r)  + Vrp  + q)  ” XB(q2  + r2)]  % 

+ [ay  ♦ z0(rq  - p)  + xa(pq  + r)  - yB(p2  + r2)]  Sy 

+ [az  + x0(pr  - q)  + yfi(qr  + p)  - Zq(p2  + q2) ] S2 

2*-  2 

Now  consider  the  left  side  of  Equation  [12],  The  term  d b/dt  is  the 
acceleration  of  point  8 relative  to  the  origin  of  the  fixed  coordinate 
system.  The  term  d o/dt*  Is  expressed  as  follows: 


2-* 
d b 


dt 


Ab  e + A0  e + A„  c 
Bx  x By  y Bz  z 


where  Agx,  A0y,  and  Ag2  are  the  components  of  AQ  along  the  axes  of 
the  prime  coordinate  system. 

Substituting  [13]  Into  [12]  yields  the  following  system  of 
equations: 





7^.  . . 


ABx  " ax  + Vpq  ■ r^  + zB^rp  + <0  ‘ xB^q2  + r2) 


ABy  = ay  + ZB(rq  " p)  + XB(pq  + ^ " yB(p2  + 


aBz  = a2  + xB(pr  * <i)  + yB(qr  + p)  - zB(p2  + p2) 


These  expressions  relate  A^,  A^,  and  A^,  the  prime  system 
components  of  the  total  kinematic  acceleration  of  point  B with 
respect  to  the  fixed  coordinate  system,  with  the  acceleration  of 
the  moving  origin  O',  and  the  components  of  the  angular  velocity 


vector.  The  quantities  Ag^,  Ag^,  A^  are  measurable  with  accelero- 


meters. The  components  of  angular  velocity  - p,  q,  and  r - can  be 
measured  with  angular  rate  sensors.  Thus,  Equations  [ 1 A ] are  a useful 
formulation  of  this  problem  for  the  purpose  of  measuring  motion. 

If  desired,  the  derivation  can  be  carried  one  step  beyond  [ l A ] . 

If  Equation  [1]  Is  recalled,  then 


dm  -*  ^ . <•'  . a 

a U » ue  + ve  + we 
dt  x y z 


2 *4 

d m dU  • a / a,  \ , *a  /-♦  a % 

— ~ » rp*  ® ue  + uU  x e ) + ve  + v(w  x e ) 

a y y 


+ we^  + w(w  x ez) 


* r\  * A */V  /A  A\ 

a up  + ve  + we  + ulre  - qe  ) 
x y z y ^ z 


+ v(pe,  - re  ) * w(qe  - pe  ) 

>•  r<  A y 


[u  - vr  + qw]  e ♦ {v  ♦ ur  • wo]  e 


♦ [w  - uq  + vp]  e 


. ■;•»■  rw-v ■ ^ v.vv.. v-, ••;' 


2 2 

The  components  of  d r?T/dt  In  Equation  [15]  are  equal  to  a^,  a , 
and  a , respectively.  Substituting  into  Equation  [14]  results 


in 


u - vr  + qw  + Yg(pq  - r)  + Zg(rp  + q) 
v + ur  - wp  + Zg(rq  - p)  + Xg(pq  + r) 
w - uq  + vp  + Xg (pr  - q)  + y0(qr  + p) 


1 2 A 2. 

• Xg (q  + r ) 

- Yb(p2  + r2) 

- Zg (p2  + q2) 


[16] 


Equations  [16]  are  a standard  formulation  of  this  problem. 

For  measurement  purposes,  however,  Equations  [14]  are  a more  direct 
and  useful  formulation. 

EULER  I AN  ANGLES 

ANGULAR  RELATIONSHIP  OF  THE  TWO  COORDINATE  SYSTEMS 

In  the  above  discussion,  all  vectors  were  defined  In  the  moving 

coordinate  system.  It  Is  both  useful  and  necessary  to  express  vectors 

In  the  fixed  coordinate  system.  In  order  to  do  this,  the  angular 

relationship  between  the  two  coordinate  systems  must  be  known.  Several 

systems  of  angles,  known  as  Eulerlan  angles,  exist  which  describe  this 

relationship.  The  system  which  will  be  used  here  follows  the  conventions 

2 

prescribed  by  the  Society  of  Naval  Architects  and  Marine  engineers. 

The  Eulerlan  angles  are  defined  by  three  successive  rotations.  The 
order  in  which  the  rotations  is  done  Is  significant  and  Is  part  of  the 
definition  of  any  set  of  Eulerlan  angles. 

Consider  a fixed  coordinate  system  Xg,  y^,  zQ.  A rotation  by  an 
angle  about  the  Zg-axis  will  result  in  e new  set  of  axes  Xj,  y^ , Zj . 
This  rotation  can  be  accomplished  mathematically  by  a transformation  [R^] 


5 

Society  of  Naval  Architects  and  Marine  Engineers,  "Nomenclature  for 
Treating  the  Motion  of  a Submerged  Body  through  a Fluid,"  SNAKE  Technical 
and  Research  Bulletin  1-5  (Apr  1950). 
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whose  components  are  the  direction  cosines  relating  the  axes: 


cos\|i  $ i nil» 

-sini|<  cosi 

0 0 


0 

0 

i 


hi 

»i 

'V 

yo 

1 

N 

0 

1  

[17] 


Note  that  the  transformation  [R,]  does  not  affect  the  z -axis. 

r o 

Thus, 


Now,  consider  a rotation  [R  ] of  an  angle  0 about  the  y,-axis, 


resulting  in  a new  set  of  axes  x2,  y2»  z2* 


‘V 


COS0 

0 

-sine 

m 

0 

1 

0 

sinQ 

0 

cose 
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X1 
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Note  that  [RQJ  does  not  affect  the  y^-axis.  Thus, 


y2  -y, 
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T/*.v{\?»57^' ,jr;S=* 7. Sv^ifltf.**"  J-,  ^ 7 : 


Finally,  consider  a rotation  [R,]  of  an  angled  about  the  x_-axls 

9 Z 

resulting  In  a set  of  axes  x,  y,  z. 


! 0 0 


0 

cos# 

s i n# 

0 

-sin# 

cos# 

x 

V 

y 

- HU 
<? 

y2 

z 

_Z2 . 

[19] 


Note  that  [R^]  does  not  affect  the  x^-axis.  Thus, 

x ■ x2 

These  three  rotations  define  the  Eulerian  angles  #,  6,  and  # 
which  are  called  the  angles  of  roll,  pitch,  and  yaw,  respectively. 
The  total  transformation  [R]  from  the  fixed  axes  to  the  rotated  axes 
Is  the  result  of  successively  performing  [R^ ] , [R^ ] v and  [R$].  That 
is, 


1 

-<  X 

f 

® [R] 

xo 

v0 

l«J 

-20. 

[20] 


where 

U)  - [«,)  t*e]  l\] 

Performing  the  indicated  matrix  multiplications  results  In 
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T-7  r ^ 1.  ►,[  $■&?} 


• VI  ••:;»'•  .-*•• 


[R] 


COS0  COSlJl 

(-sin^  cos$ 
+ cos^  sin$ 

(sintj>  sin$ 

+ cosij)  cos$ 


cose  slmji 


sine) 

sine) 


(cos^  cost 
+ si  nit  sine  sint) 


-s  i n6 
cos0  sln$ 


(-cost  sin$ 

+ sint  sine  cost) 


cose  cost 


Since  [R^] , [Rfi] , and  [R^]  are  direction  cosine  matrices,  they 


t 


and  hence  [R]  are  orthogonal.  Therefore,  [R  '],  the  inverse  of  [R] 
is  equal  to  the  transpose  of  [R]. 


or1} 


COS0  cost 
cose  sinijj 
■sine 


(-sint  cost 
+ cost  sine  sint) 

(cost  cost 
+ sint  sine  sint) 

cose  sint 


(sint  sint 
+ sine  cost  cost) 

(-cost  sint 
+ sint  sine  cost) 


cose  cost 


J 


f — — 

O o 
X > 

f 

■ 

3D 

« 

1 

*<  X 

1 

o 

r* 

i 

l«j 

[21] 


[22] 


RELATION  WITH  ANGULAR  VELOCITY 

Since  the  Eulerlan  angles  are  needed  for  some  calculations,  they 
must  be  determined  from  some  measurable  quantity,  such  as  the  angular 
velocity.  Thus,  the  relation  is  needed  between  $,  6»  and  t (and  their 
derivatives)  and  the  components  of  u,  namely  p,  q,  and  r. 

Consider  $,  9,  and  t,  the  first  time  derivatives  of  the  Eulerlan 
angles.  These  may  be  expressed  as  vectors  with  directions  along  the 
respective  axes  of  rotation:  % 

$ * $e 


e 

♦ 


6e 


*1 


where  efl)(js  Indicates  the  unit  vector  along  the  appropriate  axis.  It  can 
be  seen  from  [173,  [18],  and  [19]  that 


•?  J : L jm  [ hi^jii.iij.  in  III,  Jin  jmmji 


x2  x 


e * e 

y,  y2 


^ . a 

e = k - e 
20  21 


4>  = <t>  e 


e = 0e 


<»  » i|ie 


'I 


ft?  ♦ 

The  vectors  $,  0,  and  i|i  are  a set  of  components  of  w.  However, 


they  are  generally  not  mutually  orthogonal  and  cannot  be  transformed 


to  the  prime  coordinate  system  (x,  y,  z)  by  one  of  the  orthogonal 

t t 

transformations.  However,  notice  that  <{>  and  6 are  directed  along 


the  x2  and  y2  axes,  respectively.  Therefore,  if  \i»  can  be  resolved 
along  the  axes  of  the  coordinate  system  (x,,  y , z ),  an  orthogonal 

a. A - « - I * . r . . . t \ 


vector  triad  exists  as  components  of  id  in  the  (x2»  y2,  z2)  system. 


In  the  coordinate  system  (x} , y( , Zj),  the  vector  1 p can  be  expressed 


0 

0 

L*. 


If  the  transformation  [R0]  (Equation  (18])  is  used  to  transform  ti 
to  the  system  (x2>  y2,  z2),  then 


[23] 


“ “tjslre  e + t^cose  e 


Z2 


[24] 


thus 


w “ ($  - i^sin6)e  ♦ 0e  + i^cosee 


U5) 
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Equation  [25]  expresses  w In  terms  of  Its  orthogonal  components  In  the 
(x2,  y2,  z 2)  coordinate  system.  If  the  transformation  [R^] , Equation  [19], 
Is  applied  to  Equation  [25],  the  result  is 


Thus 


« - (Rj 

- ($  - <i>  sin  0)6^ 

+ (6cos$  + ij/cose  s 1 n4») 

+ (i(icos0  cos$  - 0sin<ji)e2 

p ■ $ - i n0 
q * 0cos4>  + ijicos©  sin<J> 
r *>  iJicosO  cosf  - Osin# 


^ - \J>sIn0 
0 

lj)COS0 


Equations  [26]  can  be  manipulated  algebraically  into  the  form 


[26] 


$ » p + (qsin$+r  cos$)  tan0 
0 ° q cos$  + r sln<)! 

» {q  sin$  + r cos$)/cos0 


[27] 


These  equations  are  simultaneous  differential  equations  relating 
the  time  derivatives  of  the  Eulerian  angles  with  the  components  of  the 
angular  velocity  vector.  They  may  be  solved  by  numerical  techniques  to 
yield  values  for  the  Eulerian  angles. 
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APPLICATION  OF  THE  GENERAL  EQUATIONS 


Now  that  the  general  equations  of  motion  have  been  developed  for 
a point  fixed  on  a rigid  body,  let  us  consider  how  the  general  equations 
can  be  used  to  determine,  from  measurements , a complete  time  history  of 
the  motion  of  the  body. 

DEFINITION  OF  COORDINATE  SYSTEMS 

Define  two  coordinate  systems:  one  attached  to  and  moving  with  the 

body  and  one  fixed  with  respect  to  the  reference  frame,  the  earth. 

Most  bodies  which  are  likely  to  be  subject  to  an  investigation  of 
this  type  - projectiles,  airplanes,  missiles,  torpedoes,  etc.  - have 
a definite  preferred  orientation.  That  is,  there  Is  a definite  "fore  and  aft, 
"port  and  starboard,"  etc.  associated  with  the  body  shape.  And  even  if  a 
preferred  orientation  were  not  obvious,  one  could  arbitrarily  define  the 
directions  forward,  aft,  port,  and  starboard  on  the  body.  Once  this 
orientation  is  established,  the  coordinate  system  (x,  y,  2)  - called  the 
body  axes  - can  be  defined. 

2 

Hydrodynamic  conventions  for  submerged  bodies,  which  will  be  followed 
here,  call  for  the  origin  of  the  body  axes  to  be  located  at  the  body 
center  of  gravity  (CG) . The  x-axis  Is  directed  forward,  the  y-axis  to 
starboard,  and  the  z-axts  transverse  to  the  x-  and  y-axes  such  that  the 
coordinate  system  Is  right-handed.  Thus,  for  an  airplane  flying  parallel 
to  the  ground,  the  z-axls  is  directed  downward. 

The  coordinate  system  (xQ,  yQ,  zQ)  - called  the  ground  axes  - Is 
fixed  with  respect  to  the  earth;  it  can  be  defined  In  any  of  several 
ways  depending  on  the  problem.  It  will  often  be  convenient  to  define  the 
fixed  coordinate  system  such  that  the  body  axes  and  the  ground  axes  are 
initially  coincident.  In  general,  determination  of  the  relation  between 
the  fixed  and  moving  coordinate  systems  can  be  based  on  the  initial  position 
In  the  ground  axis  coordinate  system  of  the  body  CG  and  on  initial  values 
- $o,  0q,  and  - of  the  Eulerian  angles  of  roll,  pitch,  and  yaw. 


ALIGNMENT  OF  TRANSDUCERS 


« 


'i 


Now  consider  the  body  and  its  Internal  transducers.  Two  desirable 
combinations  of  six  transducers  have  previously  been  stated  as  (1)  three 
accelerometers  and  three  angular  rate  transducers  and  (2)  five  accelero- 
meters and  one  angular  rate  sensor.  The  analyses  for  these  two  configura- 
tions will  naturally  differ  slightly,  but  the  general  app-oach  Is  the  same 
for  either  case. 


Combination  (1):  Three  Accelerometers  and  Three  Rate  Sensors 

If  Combination  (1)  is  used,  the  components  of  angular  velocity  along 
the  body  axes,  p,  q , and  r can  be  measured  directly.  In  order  to 
accomplish  this,  the  angular  rate  sensors  must  be  aligned  such  that  the 
sensitive  axis  of  one  rate  sensor  is  parallel  to  each  axis  of  the  body 
coordinate  system  (x,  y,  z) . Similarly,  the  accelerometers  should  be 
aligned  such  that  the  sensitive  direction  of  one  accelerometer  Is  parallel 
to  each  of  the  body  axes.  Referring  to  Equations  [14]  and  recognizing  that 
each  accelerometer  measures  the  total  acceleration  of  the  point  at  which 
it  is  located  in  Its  sensitive  direction.  It  can  be  seen  that  It  would 
be  most  desirable  to  locate  all  of  the  accelerometers  at  the  CG  of  the 
body.  Although  this  Is  a physical  impossibility,  it  Is  usually  possible 
to  locate  the  accelerometers  such  that  their  points  of  action  are  all  on 
the  longitudinal  axis.  This  si tuatlon  wl 1 1 eliminate  two  terms  from  each 
of  Equations  (14] . 

If  three  accelerometers  are  placed  In  the  body  as  shown  in  Figure  2, 
an  accelerometer  aj  will  be  directed  In  the  x-directlon  at  coordinates 
(tj,  0,  0)  of  the  body  system.  Accelerometer  Is  directed  In  the 
y-directlon  at  coordinates  0,  0)  and  accelerometer  a^  Is  directed  in 
the  z-directlon  at  coordinates  0,  0).  In  this  situation  Equation  (14] 

can  be  reduced  to 

2 2 

a.  a - C,  (q  r ) + g 
I x 1 M ax 


“ av  * Mp4  + r)  ♦ 

* > * y 

a3  " az  ’ Vpr  “ q*  * 9z 


(28] 
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where  g , g , and  g are  the  components  of  gravitational  acceleration 
x y z 

felt  by  the  accelerometers  along  the  x-,  y-,  and  z-  axes,  respectively. 

x x 


t 


Figure  2 - Alignment  of  Three  Accelerometers  Inside  a Model 
Since  p,  q,  and  r are  known  at  all  times  from  direct  measurement, 

4 • • 

p,  q,  and  r can  be  determined  numerically.  Thus,  If  It  Is  assumed  that 

somehow  g^,  gy,  and  gz  can  be  calculated,  Equations  [28]  can  be 

converted  Into  expressions  for  the  components  a*,  a , and  a,  of  the 

* y z 

translational  acceleration  of  the  CG  In  terms  of  known  quantities: 

ax  “ (a j - gx)  * t((qZ  ♦ r2) 

°y  “ ^a2  ‘ 9y)  ” + r) 

dz  " " gz^  * £J^pr  ' q* 


* 


[29] 


Combination  (2):  Five  Accelerometers  and  One  Rate  Sensor 

If  the  model  Is  Instrumented  with  Combination  (2),  the  rate  sensor 
would  be  used  to  measure  p,  the  component  of  the  angular  velocity  In  the 
x-dlrectlon.  The  other  two  angular  velocity  components,  q and  r,  must 
be  determined  from  the  outputs  of  the  accelerometers.  If  the  accelerometers 
are  located  Inside  the  model  as  shown  In  Figure  3,  a^  Is  directed  along 
the  x-axIs  at  coordinates  [iy  0,  0)  of  the  body  system.  Accelerometers 
a^  and  are  directed  parallel  to  the  yaxls  at  coordinates  {ly  0,  0)  and 

0.  0),  respectively;  a^  and  a^  are  directed  parallel  to  the  z-axis 
at  coordinates  ( l y 0,  0)  and  0,  0),  respectively.  For  this 

configuration,  Equations  [14]  become 


(a)  at  = ax  - t j (qZ  + r2)  + 

(b)  a2  ■ ay  + t2(pq  + r)  + gy 

(c)  a^  » az  + i.^Pr  ” q)  + 9Z 

(d)  a4  ■ ay  - ^(pq  + r)  * gy 

(e)  a5  = a2  - ^(pr  - q)  + 


[30] 


where  g , g , and  g are  the  components  of  gravitational  acceleration 
x y z 

felt  by  the  accelerometers  along  the  x-,  y-,  and  z~axes,  respectively. 
Subtracting  [30d]  from  [30b]  results  In 


a2  • o4  » U2  '♦  t^Hpq  + r) 
or 

r « (a2  - a1<)/(£2  ♦ - pq 

Subtracting  [30e]  from  [30c]  results  In 


00 
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or 


r CZ' ’vs  - 


t5T-?v}  its- vrnfwJr  ..i?,-;.-..- 


a^  - a^  •*  + l^)  (pr  - q^ 

q » Ur-  " aJ/U,  + lr)  * pr 
i 3 3 a 


[32] 


Since  p is  known  from  direct  measurement , Equations  [3’i]  and  [32]  are 

a pair  of  simultaneous  differentia!  equations  in  two  unknowns,  q and  r. 

These  equations  can  be  solved  for  q and  r by  a numerical  method  such  as 

3 

the  Runge-Kutta  technique. 


x 


Figure  3 - Arrangement  of  Five  Accelerometers  Inside  a Model 


Miki.l in,  S.  «.  and  K,  L.  Smoiitskiy,  "Approximate  Methods  for  Solution  of 
Differential  and  Integral  Equation*,"  American  Elsevier  Publishing  Company, 
Inc.,  New  York  (1967)  Chapter  I. 
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If  Equation  f 30b]  Is  multiplied  by  l Equation  [3Qd]  Is  multiplied 
by  ®nd  the  resulting  equations  are  added,  the  result  Is 

Va2  ' V + *2(a4  ' V ” U2  + V ay 

and 

ay  " lH(a2  " V * *2(a4  " 9y)1/U2  * V 

Similarly,  If  [3dcj  Is  multiplied  by  [30e]  Is  multiplied  by 
ly  end  the  resulting  equations  are  added,  then 

- 9Z)  + £3(a5  - g^)  * (l.  + £5)az 
and 

az  =■  [^5(23  “ 92)  ♦ *3(a5  - gz)]/U3  + l 


Rearranging  Equation  [30a]  yields 

ax  “ ^al  ’ 9x}  * £l^2  + 

Thus  If  the  gravitational  components  g^,  gy,  and  can  be  calculated, 

expressions  can  be  derived  for  the  components  a , a and  a in  the  body 

x y z 

coordinate  system  of  the  translational  acceleration  of  the  CG. 

CALCULATING  THE  EULER  IAN  ANGLES 

Depending  on  the  instrumentation  configuration,  either  the 
components  p,  q,  and  r of  the  angular  velocity  are  measured  directly 
or  p is  measured  directly  and  q and  r are  found  from  Equations  [31]  and 
[32].  These  equations  relate  q and  r with  measured  quantities  and  can 
be  solved  simultaneously  by  a numerical  method.  Before  other  desired 
quantities  can  be  calculated,  the  values  of  the  Eulerlan  angles  6,  0. 


must  be  calculated  first.  Since  the  actual  values  of  p,  q,  and  r are 
known,  Equations  [27]  can  be  solved  simultaneously  by  a numerical 
method  for  the  values  of  $,  6,  and  \Jj.  Thus,  the  members  of  the  trans- 
formations [R]  and  [R  ' ] can  now  be  calculated. 

CORRECTING  FOR  GRAVITATIONAL  EFFECTS 

Expressions  were  derived  above  for  the  components  of  the  transla- 
tional acceleration  of  the  body  CG.  These  expressions  contain  gravita- 
tional terms  which  must  be  evaluated  if  the  translational  acceleration 
is  actually  to  be  calculated. 

The  gravitational  acceleration  vector  g has  magnitude  approximately 
taken  as  g 8 9.8  m/s  at  the  surface  of  the  earth  and  Is  generally 
thought  of  as  being  directed  downward.  In  order  to  determine  the  effect 
of  gravitational  acceleration  on  the  internal  motion  sensors  of  the  body, 
it  will  ultimately  be  necessary  to  evaluate  the  components  of  g along  the 
body  axes.  The  Euler lan  angles  may  be  calculated  Independent  of 
gravitational  effects  (see  Equations  [2?],  [31],  and  [32])  for  either  of 
the  Instrumentation  configurations.  Thus,  the  transformation  [R] , 
Equation  [21],  which  transforms  vectors  from  the  ground  coordinate 
system  to  the  body  system  may  be  evaluated,  and  the  problem  becomes  one 
of  finding  the  components  of  g along  the  ground  axes. 

The  definition  of  the  ground  coordinate  system  (xq,  yQ,  zq)  did  not 
specify  any  particular  orientation  of  the  axes.  It  will  often  bo 
convenient  to  define  the  ground  coordinate  system  such  that  one  of  its 
axes  Is  directed  parallel  to  g.  In  such  a case,  of  course,  the 
components  of  g along  the  ground  axes  are  obvious.  In  general,  however, 
the  ground  axis  components  of  g may  be  found  by  the  following  method. 

Consider  a coordinate  system  (x^,  y^,  z^)  in  which  the  z^-axls  is 
directed  downward,  l.e.,  parallel  to  g.  The  vector  g may  be  expressed 
In  terms  of  Its  components  In  this  coordinate  system  as 


9 " 
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The  coordinate  system  (x  , y , z ) can  always  be  expressed  in  terms 

3 3 3 

of  a rotation  of  the  ground  axes  (xQ,  yQ,  zQ)  by  Eulerian  angles  ij>gl  6g, 

. The  angles  may  be  found  by  measurement.  The  rotation  from  the 

ground  axes  to  the  (x^,  y^,  z^)  coordinate  system  may  be  performed 

analytically  by  the  transformation  [R^]  which  is  Just  the  transformation 

[R]  from  Equation  [21]  with  the  Eulerian  angles  taken  as  to  - ,9*0  , 

9 9 

ar.d  $ » $ . 

9 

Conversely,  the  transformation  [R^]  ^ transforms  vectors  in  the 

(x  , y , z ) system  to  the  ground  system.  Thus,  if  g*  , gy  , and  gz 
S 9 9 .4-  *0  0 0 

are  the  components  of  g along  the  ground  axes. 


In  order  to  be  sure  of  the  sense  of  the  effect  of  gravity  on  an 
accelerometer,  consider  a simple  model  consisting  of  a disk  of  mass  M 
free  to  slide  without  friction  inside  a tube  and  attached  to  one  end 
of  the  tube  by  a linear  spring  of  spring  constant  c.  (See  Figure  4) 


V i ivss'vf.'i’.i 


The  displacement  d of  the  disk  from  Its  rest  position  Is  defined  to  be 
positive  in  the  sense  of  compression  of  the  spring.  Thus,  the  restoring 
force  on  the  disk  is  given  by 


F « cd 

If  an  acceleration  a,  as  shown  in  Figure  k,  results  in  a positive  output 
of  the  accelerometer,  then 


F * Ha  ■ cd 


or 


a 


cd 

M 


Now,  if  the  accelerometer  is  directed  with  its  positive  sense  vertically 
upwards,  the  acceleration  due  to  gravity  will  pull  the  disk  downward, 
resulting  in  compression  of  the  spring  and  a positive  output  from  the 
accelerometer.  Thus  the  gravitational  acceleration  causes  an  output  from 
an  accelerometer  g equal  in  magnitude  but  opposite  in  si  an  to  the 

a 

gravitational  acceleration  itself.  Thus 


The  effect  of  gravitational  acceleration  as  seen  by  accelerometers  In  the 
body  axes  is  then  determined  by  using  the  transformation  [R]  as 


■*  *■ 
V 

M 

X 

0 

9a 

*»  IRJ 

-V, 

y 

0 

\| 

L* 

"9 

3Z 
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•iff:  V 


Before  actually  performing  the  transformation,  one  should  consider 
a further  aspect  of  the  gravitational  correction.  Normal  testing  procedure 
often  calls  for  the  transducers  to  be  "zeroed"  before  making  a run.  - In  the 
case  of  accelerometers  Initially  directed  horizontally,  this  practice  yields 
the  correct  Initial  value,  in  the  case  of  accelerometers  not  initially 
horizontal,  this  practice  effectively  subtracts  the  initial  value  of  the 
component  of  gravitational  acceleration  along  the  accelerometer  axis  from 
the  accelerometer  output.  If  the  output  of  an  accelerometer  is  given  by  a, 
This  is  then 


a ( t)  - a.  (t)  + a (t)  - a (0) 

K y y 

where  a,  denotes  the  kinematic  component  of  acceleration  and  a denotes  the 
K 9 

gravitational  component  of  acceleration. 

If  each  of  the  accelerometers  Is  aligned  parallel  to  one  of  the  body 
axes,  as  stated  above,  then  the  components  of  gravitational  acceleration 
along  the  body  axes  must  be  determined.  Thus  if  the  accelerometers  are 
zeroed  prior  to  a run,  the  components  of  the  gravitational  acceleration 
seen  by  the  accelerometers  are 


9XU)  * 9 (t)  •*  9 (0) 

x x 

9yU)  • 9a  U)  “ g (0) 
r y y 

9„(t)  - g (t)  - g (0) 
i a a 


(373 


138] 
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where  [Rq]  denotes  the  transformation  [R],  Equation  [21],  with  the  values 
of  the  Eulerlart  angles  taken  as  0q,  and  i^o,  respectively. 

As  an  example  of  the  calculation  of  the  gravitational  correction, 
consider  the  case  where  the  ground  axes  are  defined  such  that  the  xQ-axis 
is  directed  vertically  upward  and  the  body  axes  are  initially  coincident 
with  the  ground  axes.  In  this  case,  the  angle  0^  • -90  degrees,  * 0, 
and  tji  ■ 0.  Equations  [36]  yield  for  this  case, 


The  angles  <j>Q,  0Q,  and  ^ are  all  zero  and  so 

9a  (0)  « g 
x 

9 (0)  » g (0)  * 0 

a a_ 


g * g cosG  cos^i 
3x 

g » g(cosi{i  sinfi  sinp  - sln^  cos$) 

y 

g = g(siniji  s i + cos^i  SlnO  cos<>) 
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Thus 

gag  - g (o)  =»  g cos6  cos^  - g 

X 3 3 

X X 

■ g(coae  cosi|)  - 1) 


Thus  for  the  case  where  the  xQ-axls  is  directed  vertically  upward  and 
the  body  axes  are  Initially  coincident  with  the  ground  axes,  the 
components  of  gravitational  effect  on  accelerometers  along  the  body  axes 
are  given  by 


g^  a g (cosQ  cost{)  - I ) 

9y  “ 9 (costp  sinQ  $in$  - slni|»  cos$>) 
9Z  ° g (si nip  sin$  * cosij)  sine  cos<J>) 


[39} 


CALCULATING  THE  TRAJECTORY 


The  final  step  in  determining  the  motion  of  the  body  Is  to  find  the 

time  history  of  the  position  of  the  CG.  Equations  [36],  (371,  and  [38] 

are  used  to  calculate  the  components  g , g , and  g of  the  gravitational 

x y 2 

effect  on  the  accelerometers.  These  values  are  Inserted  Into  Equations 

[29]  if  the  body  is  equipped  with  three  accelerometers  and  three  rate 

sensors,  or  into  Equations  [33l,  [3^1,  and  [35]  If  the  body  Is  equipped 

with  five  accelerometers  and  one  angular  rate  sensor.  These  equations 

can  now  be  solved  in  the  body  coordinates  for  a , a , and  a , the 

x y z 

components  of  the  kinematic  acceleration  of  the  CG.  That  is,  one  can 
calculate 

A * a § + a 8 ♦ a e 
xx  y y t z 
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However,  it  is  known  that,  in  the  ground  axis  coordinate  system, 
A can  be  expressed  as 

A = x (t)  i + y (t)j  + z (t) k 
o o o 


where  xQ(t),  yQ(t),  and  zQ(t)  represent  the  components  of  the  displacement 
of  the  body  CG  from  the  origin  of  the  ground  axes.  So  by  using  the 
transformation  [R  * ] from  Equation  [22], 


X 

0 

l 

X 

<u 

• « 

y0 

= [A-1] 

a 

y 

1 

o 

:n 

l 

a 

2 

m m 

40] 


These  expressions  can  be  integrated  by  using  Simpson's  rule  or  some 
other  numerical  method  to  obtain 


;0(o  . 


rt 


xo(t)  dt 


yQ(t)  * 


y0(t)  dt 


[41] 


i (t) 

o 


i *.“>« 


Equations  [41]  can  be  further  integrated  to  yield 


26 


H 

):> 


* 

i» ' 


X ( t)  - 
o 


(t 

X (t)  dt 
Q 

O 


y0(t) 


(t 

yQ(t)  dt 
o 


[42] 


2o<‘> 


ft 

z (t)  dt 
o 


o 

Equations  [42]  represent  the  trajectory  of  the  body  CG.  The  values 
of  xQ(t),  yQ(t),  and  zq(0,  together  with  the  values  of  <j>(t),  0(t),  and 
i|)(t),  represent  a complete  time  history  of  the  motion  of  the  body. 


DISCUSSION 

The  analytical  methods  described  In  this  report  permit  a determination 
of  the  motion  of  a body  In  six  degrees  of  freedom  on  the  basis  of  outputs 
of  Internal  motion  sensors.  It  should  be  noted,  however,  that  the  results 
of  any  such  analysis  can  certainly  be  no  better  than  the  accuracy  of  the 
particular  transducers  utilized.  Thus  It  Is  extremely  Important  that 
transducers  used  In  this  type  of  experiment  be  chosen  for  accuracy  and 
that  the  experiment  be  very  carefully  set  up. 

The  choice  of  configuration  may  often  depend  on  the  availability  of 
transducers  or  on  physical  considerations  such  as  the  size  and  shape  of 
the  body.  However,  If  a choice  Is  available,  the  configuration  with 
three  accelerometers  and  three  angular  rate  sensors  will  generally  be 
preferable  to  that  with  five  accelerometers  and  one  angular  rate  sensor. 

For  the  preferred  configuration,  all  of  the  components  of  angular 
velocity  are  measured  directly  and,  therefore,  some  calculations 
detrimental  to  the  accuracy  of  the  results  are  avoided. 

Since  calculations  generally  have  a detrimental  effect  on  the 
accuracy  of  the  results,  one  would  expect  that  those  quantities  directly 
measured  or  nearly  directly  measured  to  have  the  smallest  uncertainty. 

In  this  type  of  analysis,  then,  one  would  have  the  greatest  confidence 
In  the  translational  accelerations  and  the  angular  velocities  and/or 
accelerations.  In  the  alternative  photographic  method,  the  most  nearly 
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directly  measured  quantities  are  linear  and  angular  displacement.  Therefore 
If  the  accuracy  of  measurement  Is  approximately  the  same  for  the  two 
methods,  one  would  have  greater  confidence  In  the  photographic  results 
for  displacement  and  in  the  internal  transducer  results  for  acceleration 
and  angular  velocity.  It  should  be  pointed  out,  however,  that  a three- 
dimensional  photographic  analysis,  especially  for  a body  In  water,  requires 
a rather  involved  camera  calibration  and  an  extremely  careful  setup.  So 
far  as  is  known  to  the  author,  a detailed  error  analysis  has  not  been 
performed  for  either  of  these  techniques.  Nevertheless  it  is  felt  that 
there  Is  some  justification  for  the  suspicion  that  the  difficulty  in 
obtaining  accurate  basic  measurements  is  greater  for  the  three-dimensional 
photographic  technique  than  for  the  Internal  transducer  method.  In  any 
case,  it  would  certainly  be  desirable  to  perform  an  experiment  wherein 
both  techniques  were  utilized  to  enable  a direct  comparison  of  the  results. 

One  problem  Is  that  translational  velocity  Is  not  measured  directly 
by  either  of  these  techniques  and  therefore  it  must  be  calculated.  Thus 
for  the  Internal  transducer  method,  the  velocity  must  be  obtained  by 
numerically  integrating  the  acceleration,  and  for  the  photographic  method, 
it  must  be  obtained  by  numerically  differentiating  the  displacement.  The 
results  will  reflect  the  properties  of  these  mathematical  operations.  In 
general,  numerical  integration  is  a "smoothing  process"  whereas  the 
opposite  is  ture  for  numerical  differentiation.  In  general,  then,  a 
velocity  versus  time  curve  obtained  by  integrating  a measured  acceleration 
will  be  "better  looking,"  l.e.,  smoother,  than  that  obtained  by 
differentiating  a measured  displacement.  Several  launching  tests 
performed  at  OTNSRDC  have  Indicated  that  the  velocity  at  the  tube  exit 
obtained  from  the  Internal  transducer  method  was  In  good  agreement  with 
that  obtained  by  measuring  the  frequency  of  light  pulses  reflected  from 
alternate  red  and  black  stripes  painted  on  the  model. 

The  Internal -transducer  technique  has  two  significant  operational 
advantages  over  photographic  techniques.  First,  measurements  can  be 
made  throughout  the  entire  domain  of  the  body  motion  whereas  there  are 
often  parts  of  the  domain  in  which  the  body  is  not  visible  to  cameras. 


Second,  If  appropriate  data-processlng  equipment  Is  available,  the  Internal- 
Instrumentation  technique  can  yield  Immediate  onsite  results  whereas  the 
photographic  technique  requires  a multistage  process  including  film  process- 
ing, film  reading,  and  the  running  of  a rather  elaborate  computer  program. 

The  main  operational  disadvantage  of  the  internal  transducer  technique 
is  the  need  for  a trailing  umbilical  cable. 

SUMMARY 

1.  Analytical  methods  have  been  presented  for  determining  the  motion 
of  a rigid  body  in  six  degrees  of  freedom  on  the  basis  of  the  outputs  of 
internal  motion  sensors. 

2.  When  the  physical  situation  is  appropriate,  the  i nternal -transducer 
measurement  technique  is  a useful  alternative  to  photographic  techniques  for 
measuring  the  motion  of  a body  in  space, 
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